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Attitude determination of spacecraft usually utilizes vector measurements such as Sun, center of Earth, 
star, and magnetic field direction to update the quaternion which determines the spacecraft orientation with 
respect to some reference coordinates in the three dimensional space. These measurements are usually 
processed by an extended Kalman filter (EKF) which yields an estimate of the attitude quaternion. 

Two EKF versions for quaternion estimation were presented in the literature; namely, the multiplicative 
EKF (MEKF) and the additive EKF (AEKF ) . In the multiplicative EKF it is assumed that the error between the 
correct quaternion and its a-priori estimate is, by itself, a quaternion that represents the rotation 
necessary to’bring the attitude which corresponds to the a-priori estimate of the quaternion into 
coincidence with the correct attitude. The EKF basically estimates this quotient quaternion and then the 
updated quaternion estimate is obtained by the product of the a-priori quaternion estimate and the estimate 
of the difference quaternion. In the additive EKF it is assuned that the error between the a-priori 
quaternion estimate and the correct one is an algebraic difference between two four-ti4>le elements and thus 
the EKF is set to estimate this difference. The updated quaternion is then computed by adding the estimate 
of the difference to the a-priori quaternion estimate. 

If the quaternion estimate converges to the correct quaternion, then, naturally, the quaternion 
estimate has unity norm. This fact was utilized in the past to obtain superior filter performance by 
applying normalization to the filter measurement update of the quaternion. It was observed for the AEKF 
that when the attitude changed very slowly between measurements, normalization merely resulted in a faster 
convergence; however, when the attitude changed considerably between measurements, without filter tuning or 
normalization, the quaternion estimate diverged. However, when the quaternion estimate was normalized, the 
estimate converged faster and to a lower error than with tuning only. 

In last year's synposiun we presented three new AEKF normalization techniques and we compared them to 
the brute force method presented in the literature. The present paper presents the issue of normalization 
of the MEKF and examines several MEKF normalization techniques. 


I. INTRODUCTION 

The normalization of the attitude quaternion in the AEKF was presented in past work [1,21. Several 
techniques were developed and briefly tested. Those techniques included the following: brute force 

normalization of the quaternion (BF), considering the normalized quaternion a 'pseudo-measurement 1 and 
udpating the quaternion in the usual manner (OPM), considering the magnitude of the norm a 'pseudo-measurement 
and updating the quaternion in the usual manner (MPM), and finally developing the AEKF algorithm with a 
normalized attitude matrix, or the 'linearized orthogonalized matrix' normalization (LOM). Each method was 
shown to improve the attitude estimate and to speed convergence of the filter. 

Several normalization techniques are also presented for the MEKF. Ue found that normalization in the 
MEKF is necessary to avoid divergence, even when the attitude does not change considerably between 
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measurements. In the MEKF there are three points in the update cycle at which normalization can be 
performed. Ue present the methods for each, along with OPM and HP* methods, developed for the MEKF. 

Each of the AEKF and MEKF methods are tested with data from a spacecraft in which the attitude does not 
change cons.derably between measurements. Fine Sm sensor. Earth sensor, magnetometer, and gyro data are 
used from each spacecraft. Finally, the results of the MEKF normalization methods are conpared to those of 
the AEKF. Tests us.ng data from a spacecraft undergoing high turning rates are currently being conducted 
but were not ready for publication in this paper. 

In the next section we summarize the use of the AEKF and MEKF for attitude determination. In section 
III we explain the role of quaternion normalization in the AEKF and MEKF. In the following sections we 
present each of the normalization methods for both filters. Test results using seated Earth Radiation 

get Satellite (ERBS) and Upper Atmospheric Research Satellite (UARS) data are given in Section VI and the 
conclusions follow in Section VII. 


II. THE EKF ALGOS I TW 

The EKF algorithm is based on the following assumed models 

System model: X = f(X(t),t) ♦ w(t) (1) 

Measurement model: z k = h k (X(t k >) ♦ (2) 

where: X(t> = state vector 

w(t) » zero mean white process 
* zero mean white sequence 

The measurement update and the propagation of the state estimate and of the error covariance are performed 


V° * X k <-> ♦ K^ - h^X^-))] (3) 

P k e) « U - K k M |t lP |[ C-)EI - K k P k C-)]T ♦ K k R k K k T (4) 
X(t) = f(X(t),t) (5) 

P(t) = F(X( t) , t )P( t ) + P(t)FT(X(t),t) ♦ Q( t ) (6) 


f(X(t,t)| 

where: F(X(t),t) = | 

X(t) | X(t)= X(t) 

h(X(t)> | 

H(X( - ) ) = 1 

X(t) | X(t) = X(t) 

P k * estimation error covariance matrix 
* k * covariance of the white sequence, ^ 

°k = s P* ctral density matrix of the white process, w 
= gain matrix 

The state vector is given as 


where: g = four quaternion components 
b = three gyro bias components 


* T = I g T , b T ] 


(7) 
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Note that equation (3) is the combination of the following 

(8) 

(9) 

( 10 ) 

where: * effective measuretnent or residual 

- actual measurement 

h. (x, ( - ) ) = the estimate of the actual measurement 
-tc He 

The relationship between (3) and <8) has been presented in past work 13]. The first four components of ^ 
are corrections to the g estimate by the EKF,. denoted as dg. These are added to g^-). the best estimate of 
g, to give g fc (*>. The remaining elements in ^ are the corrections to the gyro bias which are also then 
added to the best estimate of the gyro bias. 

In the MEKF the quaternion elements of x are treated differently. The definition of x is given as 


x k <+> - x k c-> ♦ x k <t k > 

W = 

\ = *k * 


x T (t. ) = | « T , ib T | (ID 

L J 

where: g T = [ #, e, <i ] = three small angles based on the assumption that the error quaternion is composed of 
L J three small angles (vector) and 1 (scalar) 

5b = corrections to the gyro bias 

The correction to the quaternion, given as dg fc , is then constructed according to 

dg T k = m | *e I U I 1 i 

and the quaternion is updated as 

Whereas the gyro bias is updated according to (8). The udpated gyro bias components and g k <+) are augmented 
into the state vector (7). For further discussion of the MEKF see [41 . 

The dynamics for both filters has been presented extensively in previous work and will not be included 

here. For reference see (1,2,3]. 

III. THE ROLE Of QUATERNION NORMALIZATION 

The state measurement update equations are given in (8) for the AEKF and in (12) for the MEKF. Unless 
convergence has been attained, the i^idated quaternion g<+), is not necessarily normal, even if g(-) is. We 
know, however, that the quaternion which the algorithm is trying to estimate is necessarily normal. We can 
then’enforce normalization on g fc (+) with the hope that the enforcement of this quality of the correct 
quaternion will direct the estimated quaternion in the right track and will enhance its convergence. 

Indeed, it was found in the past 12,5] that normalization is helpful. In particular, it was found that when 
the attitude varies slowly between measurements, normalization, although not necessary, resulted in a faster 
convergence; however, when the attitude changed rapidly between measurements, either filter tiding or 
normalization were necessary to avoid divergence. The use of normalization is superior to tuning because, 
first, tuning involves a tedious trial and error process, second, tuning is not a robust solution, and 
third' with quaternion normalization the final attitude estimate is closer to the correct quaternion. 


( 12 ) 


(13) 


IV. AEKF NORMALIZATION TECHNIQUES 

Following is a suimary of the AEKF normalization methods. The details are given in Cl]. 
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4.1 Brute Force Normalization (BF) 


After X^ has been computed in (8) the quaternion part of the state is normalized as 

\ = 9 k < + )/|g k (+>| (14) 

and is augmented into X^*). This method was first presented in 15], where it was shown that the operation 
performed in (14) is equivalent (to first order) to 

% (♦) = ig^c - > ♦ d^c*)] - c^ t <->a k T c*g k <^) d5> 

The final term, - )g (( T dg k (+), is a residual term, not found in (8) that must be compensated for in the 
filter computations. This term is retained after the normalization is performed and accounted for in the 
next stage of the filter operation. This mode of normalization does not affect the covariance computation 
of the EKF [5], This computation constitutes an outside interference in the EKF algorithm and adds a 
certain complication to the algorithm. 

4.2 Quaternion Pseudo- measurement (QPN) 

In this algorithm the updated quaternion, g k , is used to form a pseudo- measurement as follows 

*n (k = 3 k < + )/|g k <*)| (16) 

The pseudo-measurement is, of course, a normalized quaternion. A measurement update is performed based 
on this measurement. The'relationship between the measurement ^ and the state vector is formulated as 

*n,k = H n,A + °n.k < 17 > 

where: H n = diagll , 1 , 1 , 1 10. .0] 

n^ ^ = w^ite measurement error 

The covariance, ^ is set to be the diagonal matrix 

R n,k = dia ® Cr, » r, * r, * r, J 08) 

where r is a small number. By adjusting the value of r we determine the degree of the imposed normalization 
on y*).The OPN is performed after the state update, so the apriori state estimate is The output 

of this update is the full state vector, not just the estimate of x which is the difference between x and 
its estimate X ^ ( ♦ ) . The state update is performed as 

- XfcO ♦ k - H n>k ^c*)l (19) 

“ here *n,k ,s C0 "'P uted usin 9 the tpdated covariance which corresponds to X.(+) and H and R above. The 
covariance is then recomputed according to (4) and the new state and covariance are propagated as before. 

It is i^iortant that r be well tuned. If r is too small the filter will atteapt to replace the 
quaternion estimate by the normalized *iaternion. However, a small r increases the variance of the 
quaternion estimation error, and a high credibility is assigned to the normalized quaternion even when it is 
not yet the correct quaternion. New measurements are not allowed to alter the quaternion estimate and the 
filter is stuck on a wrong estimate. This required tuning gives the algorithm a disadvantage. This 
disadvantage is overcome when the following normalization scheme is used. 

4.3 Magnitude Pseudo- measurement (MPM) 

In this scheme we use the square of the quaternion Euclidean norm, whose magnitude is assuned to be 1, 
as the measurement; that is 
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(20) 


n,k 


1 ♦ v. 


n,k 


uhere v ^ is assuned to be a white measurement noise with variance r. This measurement quantity is a non 
linear function of the quaternion components. The effective measurement, y nk> is computed as 


y n,k ~ n,k 


[q( + > 


1,k 


q( + ) 


2,k 


q( + ) 


3,k 


+ q(+> 4,k t3 


( 21 ) 


Following the derivations of [1] this is rewritten as 


y n,k 


* 1 * l 9 j,ki' 


( 22 ) 


and R = r. This method does not have the tuning problems of the QPM. A small r does not imply that the 
measurement of g is precise, it implies that the measurement of |g|* is precise. So the estimate of g does 
not stick to a wrong value, since the variance of g doesn't approach the value of r. 


4.4 Linearized Orthogonal i zed Matrix (LOM) 


When the quaternion is of unit length the attitude matrix, A(g), is orthonormal. 


that 


A (g) = 



(23) 


It was proven in C6] 


is orthonormal and is the closest orthonormal matrix to A(g). Using A (g) in the development of the AEKF 
rather than A(g), practically enforces normalization. 


V. NEKF NORMALIZATION TECHNIQUES 


The normalization methods developed for the MEKF are presented here. In contrast to the AEKF algorithm, 
normalization is essential in the MEKF to avoid divergence. The first three methods, discussed in the 
ensuing, force normalization during the udpate of the quaternion. The final two methods are pseudo- 
measurement techniques similar to those presented for the AEKF. 


5.1 Forced Normalization 

After g^(+) has been computed in (13), normalization is forced as 

\ (24) 

No compensation is performed because no consequent divergence of the MEKF has been reported in the 
literature [7]. We refer to this method as 'normalized q*. 

The next method of forced normalization is to normalize dg from (12). This is performed as 

|dg| = (dq,/ ♦ dqz/ + < 25 > 

dg*. fc (*> * dq. k (*)/|dg| (26) 

dq 4>k = Vl^l 

The norm l i zed dg* k is then used in (13) to compute g^ This method is referred to as 'normalized dq'. 

The final method forces normalization of the three small angles irfiich form the attitude portion of the 
MEKF state, given in (11). Each of the angles is sealed to yield 

♦* = ♦ 9* ♦ S' ♦ 4) 14 (27a) 

9* * 29/C*' * 9 ' ♦ s* + 41 " (27b) 
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The elements of dg are coasted as 


r ■ 2r/[#» ♦ 8* «• fi* ♦ 4]* 

(27c) 

* * 

*1.ke = **. 

(28a) 


(28b) 

* **i.k „ 

(28c) 

dq 4 = 2/t*» + 0* ♦ »« ♦ 4]* 

(28d) 


Performing the scaling given in (27) results in the dg* given in (28) being normal. The normalized 
dg is then used in (13) to compute g^). This method will be called 'normalized alpha', in reference to 
the vector, g, of small angles in (11). 

These methods constitute an outside interference in the MEKF algorithm. The covariance matrix is not 
affected. The complication of compensation is not added since divergence was not detected. 


5.2 Quaternion Pseudo- measurement (QPM) 

In this method we normalize the small angles of (11) and use them as the 'pseudo-measurement'. The 
relationship between dg and the angles is given in (12) and is repeated here. 

dq 1 = */2 dq 2 =0/2 dqj = x/2 dq^ = 1 (29) 

Normalizing dg gives 

dq . 

* ^ 1 

.* : . (30) 

(dq^ + dq^ ♦ dq^* 1) 

Use (30) in (29) to obtain 


= W/[(*/2) , +(0/2)**(M/2)*+1)' i 

(31a) 

*6* = W/l(*/2) , +(0/2)**(i»/2)*+1)' 4 

(31b) 

V* = W[(*/2) , +(e/2)»+(/t/2)*+1) ,i 

(31c) 

* - P*. e - F«, x = pa 

(32) 


where p = 2(** ♦ e 1 ♦ a* ♦ 4)'* 

Note that dq 4 is not a part of the filter state. Ue assign it a value such that dg will be normal after the 

OPH update. Following is a summary of the algorithm computations in the order in which they are performed by 
the filter. 

First p from (32) is computed using the updated angles of (10). The pseudo- measurement z is then 
computed as 


Z 1 * P* z 2 = P® = F# (33) 

The vector z is related to the state vector as z = ♦ r^, where x is given in (10). The measurement 

matrix, H n , and the noise covariance matrix, R n , are, therefore, defined as 


H = 
n 

R * 


”3x3 I 2 °3 x3 J 
Cdiag r ] Jx3 


(34) 

(35) 


where r is a small nmber. A Kalman update is performed and the new covariance matrix is confuted as follows 

K n = P(+ > H n TtH n PMH n T + R nJ' 1 <38) 
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(37) 


**<+> » x( + > ♦ K n Cl - H^xC*)] 

"*<*> * <' ‘ W P(+ > ( ' ' K n H / * Wr/ (M) 

where P(+) = updated covariance matrix (before normalization) 
x( + ) * results of measurement update given in (9), 
with x^ = *, x^ = ©, Xj = il 

* * 

The elements of dg are computed as 

-* -* -* ** ** ■* 
dq 1 - • /2 dq 2 *0/2 dq ^ = m /2 

- * ** *★ ** 
where the angles, t , 0 , and jt are the first three components of x ( + ). 

computed as 

dq* 4 = 2(*» + 0' + ii' + 4)"' 4 
Finally, the quaternion is computed using (13). 

g\(+) * 1 (40 

This method exhibits the same tuning problems as the AEKF QPM. Here, too, it is important that the r 
be welt tuned to avoid getting the quaternion estimate stuck on the wrong value. Again this presents 
somewhat of a disadvantage for this method. 


(39) 

* * 

The fourth element of dg is 

(40) 


5.3 Magnitude Pseudo -measurement 

This method uses the magnitude of the normalized angles (10) as the measurement. Recall from (32) 


p = 2(** + e l ♦ ** + 4) 


-V* 


(42) 


Ue use p to normalize the angles 


Following (11), we rewrite (44) as 


♦n - p*. e n * pe. = » 


^ = pa 


(43) 


(44) 


The magnitude of a is related to the estimate of the individual angles as follows 


|ot |* = p'(** +0* + il*) 


(45) 


The measurement z is defined as 


z 3 la | * ♦ n 
1 ~ n * 


(46) 


The effective measurement to be processed by the MEKF is then given as 

y * z - | a | 1 (47) 

We need to express y as a linear combination of the difference between and a. Substituting (46) into 
(47) yields 

y = | a | *+ n • | at | 1 (48) 


529 



Define Sq as 


r . . i 

. . I ! ♦ *! I 

^ = 2 U® 5 | 0 + f0 | (49) 

I i ♦ * I 

L J 

Substituting (49) into (48) gives 

y = (* ♦ 6*)* + (0 ♦ * 0 )* ♦ U + * (t 1 ^*^*) - n (50) 

Neglecting squares of £*, <$8, SfL yields 


y = 2 §6§ * 28 60* 2 jiljt ♦ n (51) 

or . r . i 

y « [2*, 29, 2»]|ft | (52) 

i» i 
i* i 

L J 

This defines the measurement matrix, H , as 

' n* 

H n = C2f, 29, U, 0, 0, 0] (53) 

The HPH algorithm is then carried out as follows. 

First p* is computed and used to obtain y. 

y * (p* - 1) (54) 

Then is computed and a small value is assigned to r, the uncertainty corresponding to n of (46). A 
Kalman update is performed and the covariance is updated. 

*n = p < + > H n T /CH n P(+)H n T ♦ r] (55) 

x*<+> = x( + ) ♦ K [y - H »(♦)] (56) 

n rr- 

p*(+) * (I - IC H )P(*)(I - rn T (57) 

nn nn nnn 

where P( + ) = updated covariance matrix (before normalization) 
x(+) * results of measurement update given in (9), 
with x 1 = ♦, x 2 * 0, ■ a 

* * 

The normalized dg is then constructed. 

dq 1 * VS* , dq 2 * S»*. dq* 3 * VS ** (58) 

** *# 

Again, since dq ^ is not a part of the state we assign it a value such that dg will be normal after the MPM 

update. 

dq A = 2(* * ♦ e * ♦ n * ♦ 4) " (59) 

The quaternion is then updated according to (13). 

9 3 g^-Odg** 1 (60) 
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This Method is not subject to the tuning problems of the Q PM for the same reasons as those given above 
for the AEKF M PM. 


VI. RESULTS 


The algorithms presented in this paper were tested using clean, nominal simulated data from the Earth 
Radiation Budget Satellite (ERBS) and noisy simulated data from the Upper Atmospheric Research Satellite 
CUARS). Two UARS datasets were created. One contains simulated data from a nominal 1 revolution per orbit 
(RPO) attitude and the other contains a 0.5 deg/sec simulated yaw maneuver. The ERBS data is taken with the 
spacecraft in its nominal 1 RPO attitude. The initial attitude error was 5 degrees and the value of r for 
the QPM and M PM algorithms was 10' 5 for both the AEKF and the MEKF. Ue studied the behavior of each 
algorithm early, which we refer to as the transient period, and after convergence was achieved, which we 
refer to as steady state. Note also that each of the figures included starts with the first update, not with 
the initial attitude error of 5 degrees. 

Ue first compared the AEKF normalization algorithms. All of the methods, including not normalizing at 
all, converged quickly. Figure 1 shows the first 5 seconds using ERBS data. The BF converges the quickest 
and the LOM the slowest. The 0PM and MPM are similar to not normalizing. Figure 2 shows the transient 
period using the 1 RPO UARS data. ALl the methods converge quickly; the QPM has a slightly lower initial 
RSS attitude error. In the steady state, all the methods, including not normalizing at all, achieved 
similar, low RSS attitude errors. Figure 3 shows results from the UARS yaw maneuver. The LOM has the 
lowest error. 

For the MEKF, normalization was found to be essential. Figure 4 shows the MEKF transient results from 
the UARS 1 RPO data. All the methods converge quickly. The results of not normalizing don't converge as 
low as the normalization results, and beyond the 10 seconds shown begin to diverge. In steady state, all 
the normalization methods achieved low RSS attitude errors. Figure 5 shows results from the UARS yaw 
maneuver. The three BF methods are slightly better than the QPM and MPM methods. Figure 6 shows steady 
state results, using ERBS data, for the three BF methods. The 'normalized dq' and 'normalized alpha' 
results are slightly better than the ’normalized q 1 results. 

Finally, the two filters were compared. Figure 7 shows the BF method for the AEKF versus the 
•normalized dq 1 method for the MEKF, in the transient period, using ERBS data. The AEKF converges a little 
faster than the MEKF. Figure 8 shows the steady state results from the UARS yaw maneuver, comparing the 
AEKF LOM and BF to the MEKF 'normalized q' . The MEKF 'normalized q' method has a lower RSS attitude error. 
The results of these comparisons of the two filters, in both the transient and steady state periods, were 
found to be true for the other methods as well. 

VII. CONCLUSIONS 

We found that all of the normalization methods presented work well and yield comparable results. In 
the AEKF, normalization is not essential since the data chosen for the test does not have a rapidly varying 
attitude. In the MEKF, normalization is necessary to avoid divergence of the attitude estimate. When the 
spacecraft experiences low angular rates, all of the methods for each of the filters have similar behavior. 
The choice of which algorithm to select as superior depends on the complexity of each algorithm. The 
pseudo- measurement techniques, for both the AEKF and MEKF, blend the normalization into the Kalman filter 
algorithm, but they don't represent an actual physical measurement, and are therefore somewhat obscure in 
their derivation. In addition, the QPM method requires the added burden of tuning. The AEKF BF algorithm 
is cooplicated by the need to condensate. The LOM method blends naturally into the filter development, 
using a normalized attitude to derive the filter update equations. The LOM is the slowest to converge but 
achieves the lowest RSS attitude error. In the MEKF, the brute force technique of normalizing the 
quaternion is the easiest to implement and is the most straight forward, but the other two brute force 
techniques have slightly better performance. All of the algorithms will be further tested with data from 
UARS undergoing a high turning rate. This may help to determine tiiich of the algorithms, for each of the 
filters, has the best performance and may further substantiate the claim that under high rates normalization 
helps speed convergence and eliminate the need for tuning. 


531 



TIME (sec) 

Fig. 2 UARS AEKF: Noisy Data, 1 RPO Attitude 
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RSS Attitude Error (deg) 



TIME (sec) 

Fig. 3. UARS AEKF: Yaw Maneuver, Noisy Data 







RSS Attitude Error 



Fig. 7. ERBS BF Normalization: AEKF vs MEKF 



Fig. 8. UARS AEKF LOM,BF vs MEKF Normalized q: Yaw Maneuver, Noisy Data 
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